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(54) CONTROL DEVICE FOR LEG TYPE MOVING ROBOT 

(57)Abstract: 

PROBLEM TO BE SOLVED: To provide a control device 
for a leg type moving robot in a condition likely tumbling, 
so as to reduce as small as possible damage received by 
the robot by its tumbling and damage of a mate side 
object against which the robot collides when it is 
tumbled. 

SOLUTION: By an abnormality processing device 13 
provided in a robot R, whether the robot R is placed in a 
condition likely tumbling or not is judged one after 
another, when a condition likely tumbling is judged, by a 
robot leg control, device, so as to lower down the center 
of gravity of the robot R (waist down) by a robot leg 
control device 1 1 , an actuator 5 of a movable leg 3 is 
controlled. The condition likely tumbling is judged by 
whether a residual capacity of a battery 1 5 is decreased 
or not. In the case of lowering down the center of 
gravity of the robot R, regenerative generation power 
generated in the actuator 5 (electric motor) is returned 
to a side of the battery 15. 
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■*"*»fH*«ttH>5¥«S:»^T*5< rfc-C, WET*?- 
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<&2«|§i9^lEHElbfls£:?T5 *3<7}-C\ 2®C0^@)^— ^ 
(Bi-CliB/TfW let B*j*Sjx-cw*«. -£L"C\ 
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6^6**6it*^ B#yh«BB«Inic±ot 
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y h R.^#^I®iWl 3 <0£¥ffl 7 fcflMBi-£*sy7&£*/S 
Lt^^T^^.tLT, CO^K*<0B«ffi;&SB* 
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> f*j3t#»*0>-*— * > hric^iS roj 
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s^ptt 7 tc^-t-s b s^s^ 

[0 0 5 5] ±J*«fflMH£)Effi«S 3 5 tt^S^S 3 0 

2 4ICJ: Ottffl^ixSo^y hRO^IIM^^ 

errx £ ^>&^Tp]Ih3 9 CDijUJlE 0 erry 

Mdmdx= — Kthx- 0 errx— Kwx • 
Mdmdy= — Kthy • 0 erry— Kwy • 
--t Kthx, Kwx , Kthy, Kwy Itttl^tlffifeVSfJ 

[0 0 5 8] Z<D± 5 \Z*LX&:fc£tlZffii&^fcJj^ 
-^VhMdmdx, Mdmdy^ffifi, -h#£«MBI! 0 errx. 

& miBi- 5 ft "CO ±*g§MH3g 0 errx, 

»»«JS0errx. 0 erry 2* < X fc, *OSCfka 

hMdmdx, Mdmdytt, ttSft/hSfttOt.ftS. 
[0 0 5 9] T>^nff»3e«3 211, 

^ V hMdmdx. Mdmdy) £ O-g^fCilSf^-grS J; j 
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dmdy-e£>£ (£*T\ > hMdmdx, Mdmdy 

£fb*J»«J|« 3 6 tt, 1fMfc£*R^— > ^ KMdmd 
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(1) , (2) fcJt 5*36-^5. 
[0 0 5 7] 

( d 0 errx/ dt) (1) 

( d 0 erry/ d t ) ( 2 ) 
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tt^^e-y V h*»tt*t*^*S*^-^ > hMdmdx, 
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^ie l r ft $ «f:e g BJ^sp-ttB/sgswfcit ica3 <t 5 ^j^i 
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.^-^&&a^i 6 ict o^aasftsirr^^— 
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B«JS«tB/»SSWl, ^oT, Kcijif-x KRO*JS 
T»7 0*»ottfi/»»«:«ft«ctt % ±B*«^R 
^ V hMdmdx. Mdmdyri* g^^^^^'C^Inl 
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JCasJfy hR^mS{KIiCj^i-i: 3/^-^ > h ( = Mdm 
dy) o 
[0 0.7 2] L^Sid, M«^^^-^>hMdmd 

oo, Mflt^^S^?^—^ > hMdmdx, Mdmdy££ifL 
J: 5 (CJE¥« 7 <DteK/»f&**iEi-3 w fc ttXM 

[oo7 3] zvtisbiz, m&mwmm^m2 7i±. m 

o \Z.Wfa<£fcKf}^~ * > h Mdmdx, Mdmdyri*^f 
3£tt£iB;ifc»& (<fc9!£L<te, Mdmdx.XliMdmdy;&S 

JH) k-J3<D3:¥-$t7 <Dfr&mmi,X^Z>&i1gl (frHiJ 

[0074] -fftfc*^ Hntmtittt, »«^^ 

y V h Mdmdx, MdmdyiS|t«itt*fr < Tt, Pj^^F 

> h Mdmdx. Mdmdy £ g ^t^^j 'L\$M 9 Id^if 

^Ftt 7 0*<&ffiB/£?^tf Efc: £ o X*lflt^*K** 
— v h Mdmdx, Mdmdyfc 5 fc£ 

V h Mdmdx. Mdmdyte, MHXSfllCik 

[0075] ***»«-efi, 6fl*iK#ft2 

7 HJ:5«W«rfT3 fcfcfctt«**RA-=E~* > hMdm 
dx, Mdmdy^ltg-r^mrfaff^^:^, o zK y h R (Dffim 

[0 0 7 6] S^ttroffia/^SSotfiE^io-c 
*<L*«C fc#^TMl4»«±«W**— 7« > hMdmd 
x, Mdmdyte. ^¥S7«^iCj:ot, -j&lCfcfc-e 
tifn^-^ V hMdmdx, Mdmdy^d^&STttf), $ 
ibtCl, ^Itflfc^R;^—;* > h Mdmdx, Mdmdy 

[0 0 7 7] ftlc, *HjK^ffi^3SH^mft, Su 
E<Efi*U»f^&2 7i:j:otn^7 hR^KiL-e^^ 

[0078] roas^a «9 % tiria*sr*Q ; 3iSB 1 3 m 3 
^x.^<^fy 1 s^i^itfl^t^j 



f^W«Ii 1 (»L<fi$84*g3 0) tic**. 

[0079] r<^i:#, bmmmmw: 1 1 

[0 0 8 0] Z<DfZ$), *tfyhR<DM.b&T&9, Z 

i s S*t5«»ttifc«W/h**tW-car^, Pdf^y hR^ 
tt#«©4fc*^art 5 r <b 7PX# 5 0 ' * 

R^efiiL-tSttJKlB-efcSirWWfl-S^:*, -tO^JBf 
5rWfiS^5 r <kds-e#. r>v>T«:, JiteoJ: 5 lcn# 

[0 0 8 1 ] M^iMl 3 0»fp«JBtti^# 

fri^miftfr^^*<Dm'&<Dffifcn?&<nvT£y YR<Dm 
[0082] bs, *jt2S*i»-efa, liEoi^^l^ 

Hi 2i2^*V? r *LB3#:y hRC0^T®i^l3^U^rij!lfi»H4O 

idf^^r^it^-^'S j: 5 icwt^^-* s'&xmr? 

[0 0 8 3] ^±(30^ N ^$f^¥32 5^ 

[0 0 8 4] i-?ifc>^ x oaKy hR^-e^S'C^TJf 5 

& 5 ^rftj^i-^®®!^— *^ 1 %<T>o *?(DV^< o^fi, a 
#y hRcofi^JdioTlEHEL, ®£«tt:Rj|8i«£5. 

'<VT}) 1 5O0«C«S$tL57t*, K^^T^y 1 5tC3fc 
S^ixfcO, ^5V>ttffifS^>x>'i^2 2tCgx6n 

^ l 8^mrEp^^ hWffitPSBl 1 . 
iJcaajf ^ HRO|EI&J^oaf5E$:S^i--<< 
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ioTasKy h R c^fK}^^^ ^*JE*^«2 9 lC|£ 
H»»**S»fffc«r**IB9+5Mcff 5 r >d*X# 

So 

[0 0 8 5] -ett, hR^BMB^^W 

ffi&koEflt^K 2 9 me«r»s-&s r i r% 

e«^»2 9(cieig^^$n7t®if^*fl§ 

fitt^az 9icie«^^H7tibfmffiT f -^^^v> 

[0086] &&m<on2<z>nmi&m%:®a&& 
sRL-cKWi-s. *nmj&mtem&$gi<onmmm 

[0 0 8 7] 0 8lr#BgLt, *3llS*«gTtt, WE'< 
y^rV 1 5 0ffi % ffi&mmt LTW^yf !/ 3 7j6* 
tufE n 7}f ^ h R (C#£^St £ it X v ^ <5 0 r^^^, y 

1 5lSMt^<y7y 3 7<&jE«fcti\ -tn^ti, 
S^yry i saw^^fy 3 7~^m$fE£>8fEA£ 
PUh-ra^^- K3 s, 3 9is»uti, -n^^ 

19iO7>7'2 0 > 2 1^ ozffy hJHMffttKl 

W18, 19«^8«t(ltt, /<yf!/l5 
^WyryaTfcttfMiijif, ^>^V-^2 2tc 
K«Stt5 J:5lc*-o-cv^<S 0 i^k iJ-y^^y 3 7<£ 

2 ft, *HM?£*8Xf2, #1 mm ~ fiJi 31 >^ (^5 
ct 5 &&tfcft*^;I;^t>^£;f|V>X^<5 0 

[0088] ^HiS^ii-ett, ^^y 1 s<om 
&ai3&2 3&tf®£&aj§&2 4 -9-^^^y 

ffi«4 1 <aaj;^— ^fjfy/^fy 3 7^^sti 
m&$m#m^m2 »§sbs&#&2 sic £9 a 

ss^s^^ y 1 S&tflf^-yT^y 3 7£)gfc^fiC0 



5„ 

[0089] «±»pi L*:«^o«j«at«»iBr«mE» 

[0 0 9 0] d^S^HftJgUg^jeitt'^tt. 
T^y 1 5&W/<yfy 3 7 <DfflB-<D&2B-*&Hffeti[ 
$XT\zfeT^Zh. SS*&3£3£ill 3 0|E«fl»f^S 2 
7^finE^#]^j®ffi^^^LT, ^iX^nzK^ KP^J 

[0091] :(D^ V ttmmsfowTtToL^—f 

>^2 2lcgx^tL. -etL^S, ^IfrOT3?>m;^£?g^r 

felgtl3§<Oi^^LtgISnSo rKlcJ: 
9, ^yf yi SRW^yfy 3 7C0B^&2i 5/ >^ 

»fP««7 !f -^S:E«^a2 afcE»««**-5ftf^«: 

[0 0 9 2] -t IT, ZL<Dk £\ «ftHE~* 1 
^^m^ii, luE^-f K3 8. 3 9(ci;oT^yT 
y 1 S^f-^y^y 3 7\Z.%*ZtiZZkt£< 

>-^2 2jc^A^n67t* v &\si4E.&mmti&. 

o X n Tjf >^ h R (Omfftkmy*- 9 *:E«^a 2 9 Mf2t£ 

^<y^y 1 s^-tf-TV^^y 3 7 

^>^>i^2 2^Jf^<Di^/^-a^H^&?] 

>hsv\ ^ot, lttEiaiamm^t^y^y 1 5^ 

*7s<y*r)) 3 7 a 2 2(d^x.5 J: 

5lc1-6rcbX% K0£»««Z>S: % n^hROl^ 

S:T»f5»ff^ »fHft«£B*¥»2 8JCJ:oTasHs/ 
NR^S&f^t]^7 :f -^$:Etg^2 9fcE««»S-e:5 

[0 0 9 3] *^^<^m 3 ^Hffi^ffilErlSl 9 

5>fco^-c«:»i (onmmmkm—^mn^BLvm^ 
&m^xmm&<gv&~rz 0 

[oo94] *nj6«(B-ctt, luiss^^m^a 1 3 

tt, »ElE«aWWf^a2 7{c<t >9 p#y hRd5g#JL^r 
p k*M LfZk # fcfeS-t-SSJEIEtfJ^iB 

Hffl5»J»SeBl 2fct^^5Ji5JcLrv^ - ^Lt, 
asKy hWliggi lSt/B#y hK^JP^Sl 2 
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y hP^Jffligfgl ltt, gfrfS^l^^j^l^lca 
*5**|»U nsK^-HK#J»afiai 2 

[0095] £t_hi&^ Lfc«*^*j«xu«fgttma» 
[0096] frfrtt^mmmzzti^ utf?hR& 

[0097] ft, «±»WL)is:*jfcJt*«-ert,- 

L"C, flMBMflt^JfcR*^— ;* > hMdmdxXteMdmdydS 
S^Pa 7 LfcgfSflff J: 9 t> *t < *o 

^^^tf-c. Bfriss*; ci) , (2) ^Wj^mxhK, 

Kwx , Kthy, Kwy K<fc 9, nztfy h 

[0 0 9 8] WB*3Hfc»tt-er±. p#yhR# 
h 5 § # ft l c * <o se *■ m -5 1 ^ £ ^ L 

w «: a m -r 5 z k & x # 5 z k « t *> -5 a, t* 9 , 
§e>icf±, -s«-hoa«o^r«Fjw« : ^r'f-5n# J y hie 

ov>-ct>*»PJ£3/!H-'5Z ir^-ef £ o 
[0 0 9 9] U15#^4fi^J8T-li. /<jxfy^ 



7$y b&m&iL*?te&m-?hzkpmi-z3:?\zi,x 

fccfcV\ 

[0 10 0] tSfle#3IJ6«Ji-C?«4, D#yFRiS 

x.^^F»«tt^fB*^a2 9(dtfi^LrfElt$-&^ < t p 

[03] El 1 Ocrtfy h»CI«x.^:«««ia3S«(D«tg«J 

[124] m 1 coa^y b\zffittB#y bMummwL<D 

[13 6] SKDotfy h2fl5««L*3tttt«T©M'< 

[®8] *&m<Dfg2<Dnmmm\zioifz>s<vrv km 
[09] &&m<Dm3<vmm&m\z&i?z>u7$y b&m 

(Ho 

[fflF#<Oife^] 

^S) , 15, 3 (a 

S&^T^^zlzh— ^) > 2 2 - =i>^>i^, 2 5— £l« 

2 8-tff±#^^ 2 32 

3£**) . 3 5-±*S?fMB««iB«, 3 8. 3 9-y 
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